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The invention deals with a procedure and an appliance about the support of the parks of a 
motor vehicle, d. h. with an Einparkassistenten. From driving condition signals delivered by 
sensors (2), a Soll-Trajektorie is calculated in a function block (3). This consists of 
Klothoidboegen's und/oder arcs. Furthermore, an Ist-Trajektorie is calculated by the sensors 
(2) of delivered signals, especially a greed corner signal and a Wegesignals, on the basis of 
this in a function block (4). Then, debit and Ist-Trajektorien are compared, and the 
comparison result makes a calculation of the Lenkwinkels, for which a Stellgroeo M e 
investigates a function block (5), step-stationary with the phases of the Einparkvorgangs 
possible. Feed-back-Signale delivered by the sensors (2) make an exact regulation of this 
possible during the Einparkvorgangs's hit Lenkwinkel. Steering wheel interventions of the 
driver are tolerated, doesn't have any effect on the Lenkwinkel, however. The driver must 
operate gas and brake pedal merely in order to influence the speed of the vehicle. 

EXEMPLARY CLAIMS- 1 . Method about the support of the parks of a motor 
vehicle, that is with a Lenkstellmotor and sensors for the grasping of the vehicle position, the 
driving condition and variable environment conditions equipped, with what to a regular 
support of the Einparkvorgangs on the command of a driver by means of the Lenkstellers and 
supported on vorbestimmte vehicle data and on signals of the sensors is executed, marked 
through following steps :1. Recording one the backed parking of initiating command 
complaint of the driver and production of an initialization signal; 2.Recording the momentary 
vehicle position and the driving condition as the vehicle data and at least from a greed corner 
signal and from a Wegesignal; 3. Recording of the environment conditions from from sensors 
installed at the vehicle generated signals; 4.Handicap one or several Soli-Taj ektorien, that one 
of the vehicle position, the driving condition, the environment conditions and the vehicle data 
dependent debit track curve the to parking vehicle boasts; 5. Recording of a respective Ist- 
Trajektorie, dependent on the respective one(s) in the steps B and C grasped signals; 
6.Compare the SollTrajektorie pretended in step D and the Ist-Trajektorie grasped in step 
E;and 7.Calculation of the respective Stellgroeo"e for the Lenkstellmotor from the 



comparison result gotten in step F. 2. Method for claim*l,*marked:by^it, -that the 
Lenkstellmotor and at least a part of the sensors is part of a driving-dynamic Lenksystems of 
the motor vehicle. 3. Method for claim 1 or 2, marked by it, that the Wegesignal grasped in 
step B of one each is grasped at each vehicle wheel of situated Radgeschwindigkeitssensor. 4. 
Method for one of the claims 1 to 3, marked by it, that the greed corner signal grasped in step 
B is measured by a suitable sensor. 5. Method for one of the claims 1 to 3, marked by it, that 
the greed corner signal grasped in step B from one or several signals measured in the steps B 
and C otherwise, especially from 
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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

Prufungsantrag gem. § 44 PatG ist gestellt 

(S) Verfahren und Vorrichtung zur Unterstutzung des Einparkens eines Kraftfahrzeugs 

(57) Die Erfindung bofasst sich mit einem Verfahren und oi- 
ner Vorrichtung zur Unterstutzung des Einparkens eines 
Kraftfahrzeugs, d. h. mit einem Einparkassistenten. Aus 
von Sensoren (2) gelieferten Fahrzustandssignalen wird 
in einem Funktionsblock (3) eine Soll-Trajektorte berech- 
net. Diese besteht aus Klothoidbogen und/oder Kreisbo- 
gen. Ferner wird auf der Basts der von den Sensoren <2) 
gelieferten Signale, insbesondere eines Gierwinkelsi- 
gnals und eines Wegesignafs, eine Ist-Trajektorie in einem 
Funktionsblock (4) berechnet. Dann werden Soli- und Ist- 
Trajektorien verglichen, und das Vergleichsergebnis er- 
moglicht eine mit den Phasen des Einparkvorgangs 
schritthaltende Berechnung des Lenkwinkels, fur den in 
einem Funktionsblock (5) eine Stellgrd&e ermittelt wird. 
Von den Sensoren (2) gelieferte Feed- back- Signale er- 
i moglichen eine genaue Regelung der wahrend des Ein- 
parkvorgangs eingeschlagenen Lenkwinkel. Lenkradein- 
griffe des Fahrers werden toleriert, haben aber keine Aus- 
wirkung auf den Lenkwinkel. Der Fahrer muss iediglich 
Gas- und Bremspedal betatigen, um die Fahrgeschwin- 
digkeit des Fahrzeugs zu beeinflussen. 
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Beschrcibung 
Stand der Technik 

5 Die Erfindung bctriffl ein Verfahren zur IJnlerslulzung des Finparkens eines Kraflfahrzcugs, das mit einem LenksteJI- 
molor und Sensoren zurn Erfassen dcr Fahrzeugposition, dcs Fahrzu stands und veranderlichcr Umgebungsbedingungen 
ausgeruslel isl, wobci auf den Bcfehl cincs Fahrers hin cine gcregelle Unterslutzung dcs Einparkvorgangs mitlels des 
Lenkslcilcrs und gestiilzl auf vorbeslimmtc Fahrzcugdatcn und auf Signale dcr Sensoren ausgefuhrt wird, sowic cin zur 
Durchfuhrung dcs Vcrfahrens cingcrichLelc Vorrichlung. 

10 Bei eincrn zur Zcil bci der Robert Bosch GmbH in der Emwicklung befindlichen elektronischcn Lenksystcm wird 
durch cinen am Lcnkgelricbe dcr Vorderrader angebrachtcn elektronisch gercgellcn Lcnkslcllcr, ausgehend von einem 
von einem Lenkradsensor erfassten Fahrerlcnkwunsch unLcr Bcriicksichligung von fahrdynamischen GroBen die Quer- 
dynamik durch eine Modifikation dcs dem Fahrerlcnkwunsch entsprechenden Lenkwinkcls verbessert, d. h., dass das 
Fahrzeug in fahrdynamischen Situationen stabiiisiert wird. Das System weisl. einen Lenksicllmotor auf, dcr dem vom 

15 Fahrer gesteillen Lenkwinkel einen Korrekturwinkel hinzuaddiert. 

Die DE 29 01 504 beschreibl ein Verfahren und eine Vorrichlung zum Hinparken von Kraflfahrzcugen, welche mit ei- 
ner reinen Sleuerung des Einparkvorgangs arbeitet. Dabei werden keine den Veriauf der Einpark-Trajeklorie verandernde 
Feed-Back-Sign ale bcriicksichfigt, sondern statt dessen feste Trajektorien vorgegeben. 

Aus dem Patent FR 2 728 859 isl: ein Verfahren und cine Vorrichlung zur Regeiung des Einparkvorgangs bekannt. Da- 

20 bei ist aber der Fahrer noch zustandig, um Lenkeingriffe durchzufuhren. Dazu werden Sensoren verwendet, die den Gier- 
winkel und den Lenkwinkel erfassen. Unbefriedigend ist dabci, dass die Leistung des damit realisierten Systems durch 
die relativ grofic Totzeit des Fahrers bei den Lenkeingriffen beeinlrachtigt ist. 
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Aufgabe und Vorteile der Erfindung 



Es ist Aufgabe der Erfindung, ein Verfahren und eine Vorrichlung zur Unterstulzung des Einparkens eines KrafLfahr- 
zeugs so zu crmoglichcn, dass das Fahrzeug automatisch in die Parkluckc lenkt, dcr Fahrer aber sclbst durch Gaspcdal- 
und BremspedaleingrirTe die Geschwindigkeit regelt. 

Die obige Aufgabe wird anspruchsgemaB gelosl. 
30 GemaB einem wesentlichen Aspekt ist das die obige Aufgabe losende Verfahren gekennzeichnet durch folgende 
Schrilte: 



A Erfassung einer das unterstiitzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines Initia- 
lisieruiigssignals; 

35 B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens aus 

einem Gierwinkelsignal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachtcn Sensoren erzeugten Signalen; 
D Vorgabe einer oder mehrerer Soll-Tajektorien, die cine von der Fahrzeugposilion, dem Fahrzustand, den Umge- 
bungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs angeben; 
40 E Erfassung einer jeweiligen Ist-Trajektorie, abhangig von den jeweiligen in den Schritten B und C erfassten Si- 

gnalen; 

F Vergleich der in Schritt D vorgegebenen Soll-Trajektorie und der in Schritt E erfassten Ist-Trajektorie; und 

G Berechnung der jeweiligen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichsergeb- 

nis. 

45 

Dabei wird das in Schritt B erfasste Wegesignal vorteilhafterweise von einem Weggeber, vorzugsweise von je einem 
an jedem Fahrzeugrad befindlichen Radgeschwindigkeitssensor, erfasst. Das ebenfalls in Schritt erfasste Gierwinkelsi- 
gnal kann entweder durch einen geeignetcn Sensor gemessen werden oder aber aus geeigneten Signalen, bspw. aus der 
Drehrate eines Drehratensensors und/oder aus den Radgeschwindigkeiten, rekonstruiert werden. 
50 Die Umgebungsbedingungen werden in Schritt C vorzugsweise mittels eines Ullraschailsensors erfaBt. Es ist jedoch 
auch denkbar Radarsensoren oder optische Sensoren, z. B. Kameras, einzusetzen. Die in Schritt C erfassten Umgebungs- 
bedingungen konnen die Form oder AusmaBe einer Parkliicke angeben. 

Die oder jede in Schritt D vorgegebene Soll-Trajektorie wird bevorzugt aus einem oder mehreren Klothoidbogen und/ 
oder aus einem oder mehreren Kreisbogen zusammengesetzt. Ein Klothoid ist eine ebene Kurve, deren Krummungsra- 
55 dius gemaB der Beziehung R = a • a/s (R: Kriimmungsradius; s: Bogenlange; a: Parameter) stetig kleiner wird. 

Um zu vermeiden, dass die Lenkbeschleunigung und der Lenkruck zu hoch werden, wird die im Schritt E berechnete 
StellgrGBe einer Filterung unterworfen, die abrupte Ubergange an den Flanken der Stellgr6Be glattet. 

Eine zur Durchfuhrung des Verfahrens eingerichtete Vorrichtung weist erfindungsgemaB eine Regel-/ Steuereinheit, 
die von den Sensoren in Abhangigkeit von der Fahrzeugposition, dem Fahrzustand und den veranderhchen Umgebungs- 
60 bedingungen erzeugten Signale sowie die Fahrzeugdaten empfangt, Mittel zur Berechnung einer Tst-Trajektorie aus den 
Sensorsignalen und den Fahrzeugdaten, Mittel zum Vergleich der jeweils berechneten Ist-TVajektorie mit einer vorbe- 
stimmten Soll-Trajektorie und Mittel zur Berechnung einer StellgroBe fiir einen Lenkstellmotor aus dem Vergleichser- 
gebnis auf. 

Die das Verfahren durchftihrende Regel-/Steuereinheit kann uber Filtermitlel verfugen oder uber Fillermittel mit dem 
65 Lenkstellmotor verbunden sein, so dass die berechnete Stellgr6Be in der oben beschriebenen Weise gefiltert werden 
kann. 

Das oben spezifizierte Verfahren und die Vorrichtung bieten gegeniiber dem Stand der Technik mehrere Vorteile: 
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1« wird kcinc cchtc clcklronischc Slccr-by-Wirc-Lcnkung bcnoligl. Dcr bei dcm in dcr Enlwicklung bcfindlichen 
fahrdynamischcn Ixnksystcrn cingcseiy.le Lcnkslellmolor ist ausrcichend, da cr automalischc, genauc und schr 
fcinc Ijcrnkeingrirfc ermoglichl. 

Die vcrwcndclcn Sensoren ermoglichcn cine genauc Bercchnung dcr gefahrenen Bahnkurve und damit.cinc gc- 
naue Regelung des Einparkvorgangs mil slandigcn Korrckltiren und Anpassungcn. 

- Die Auswahl der jcwciligen Soll-Trajektorie unci ihre Kombinalion aus Klothoidbogen und Kreisbogen cnnog- 
lichl cine cinfachc Bcschrcibung der Trajektorie und cine schncllc Bercchnung des Vcrgleichscrgebnisscs zwischen 
LsL- und Soll-Trajekioric wahrend des Hinparkvorgangs. 

- Die durch die Rcgel-/Slcucreinhcit ausgeluhrlc Rcgelung ermoglichl. ein praziscs Manover und Icinporarc Ab- 
weichungen von dcr Soll-Trajekioric, um den Fahrkomforl zu erhohen. 

Die Fillcrung erhohl den ] 'ahrkomfort, da sic ruckhaflc Bewcgungcn des Lcnkrads glaltcn kann. 

Die nachslehende Beschrcibung beschreibl. cin bevor/ugtes Ausfiihriingsheispicl des erfindungsgeniaRen Verfahrens 
und erlaulerl. gleichzcitig die Durchfuhrung durch die crfindungsgcmaBc Vbrrichtung unler Bezug auf die bciliceende 
Zeichnung. 

Zeichnung 

Fig. 1 zcigt scheuiaiisch Punktionsblockc der erfindungsgernaBcn Vorrichlung; 

Fig. 2 zcigt graphisch die geonielrische Grundlagc zur Hrmittlung eincr Bahnkurve iiber den Zusarnmenhang zwi- 
schen dcm Kriimmungsradius R, dem Winkel G und dem Wcg s; r 

Fig. 3 zeigt graphisch ein Klolhoid als cin Kurve, dcren Krummung c(s) sich linear mil dem Wcg s veranden; 

Fig. 4 vcranschaulicht in einer ebenen Darstellung eines Kraflfahrzcugs GroBen, die zur Bestinnnung der Klothoidbo- 
gen dienen; 

Fig. 5 eriautert graphisch eine Trajektorie und einen Lenkwinkel fur einen Fall, wo eine Fahrt am Lcnkeinschlag not- ^5 
wendig ist; & - 

Fig. 6 zcigt graphisch cine Trajektorie und einen Lenkwinkel fur cincn Fall, wo kcinc Fahrt am Lcnkeinschlag not- 
wendig ist; 

Fig. 7 zeigt eine mil dem dargestellten Algorithmus erzielle Einpark-TYajektorie. 

Ausfiihrungsbeispiel 

Das im nachfolgenden Text dargeslcllte Ausfuhrungsbeispicl eines erfindungsgernaBcn Verfahrens zur Unterstiitzung 
des Einparkens eines Kraftfahrzeugs und einer zur Durchfuhrung des Verfahrens eingerichteten Vorrichtung (kurz: Ein- 
p arkassi stent) verwendet insbesondere folgende Sen soren: 
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- UltragschaJlsensoren zur Erfassung der Umgebungsbedingungen; 

- aktive Radgeschwindigkeitssensoren, die Radgeschwindigkeiissignale bis zura Stillstand des Fahrzeugs liefem; 

- einen Lcnkwinkelsensor; 

- einen Drehratcn sensor, mit dem Signale uber die Giergeschwindigkeit erfassbar sind; und 40 

- (optionell) einen Querbeschleunigungssensor. 

Es ist derikbar, in einem anderen Ausfiihrungsbeispiel der vorliegenden Erfindung einen oder mehrere der beispielhaft 
angefuhrten Sensoren wegzulassen, entweder weil das erfindungsgemaBe Verfahren auch ohne das von dem entsprechen- 
den Sensor geUeferte Sensorsignal voll funktionsfahig ist, oder weil das Sensorsignal aus anderen Sensorsignalen rekon- 45 
struiert werden kann. Welche Sensoren zur Durchfuhrung des erfindungsgemaBen Verfahrens tatsachlich eingesetzt wer- 
den kann von einem Fachmann anhand seines Fachwissens im Einzelfall enlschieden werden. Es ware es bspw. denkbar, 
auf einen Drehraten sensor zu verzichten und das Drehratensignal aus anderen Sensorsignalen zu rekon struieren. 

Fig. 1 zeigt Funktionsblocke des Einparkassistenten. Aus dem Block 1 stehen Fahrzeugdaten zur Verfugung. Bei- 
spielsweise ist der Block 1 ein Speicher, in dem die Fahrzeugdaten abgespeichert sind. Eine alternative Moglichkeit ist so 
ein Rcgel-/Steuerwerk, das die Fahrzeugdaten enthalt. Der Block 2 ist der Sensorblock, der die oben erwahnten Sensoren 
umfasst Der Funklionsblock 3 berechnel die SoU- Trajektorie in der weiter unten beschriebenen Weise und erhall dazu 
die Fahrzeugdaten aus dern Block 1 und die Sensorsignale aus dem Block 2. 

Ein zur Ermittlung der Ist-Trajeklorie vorgesehener Funklionsblock 4 erhalt ebenfalls die Fahrzeugdaten aus dem 
Block 1 und die Sensorsignale aus dem Block 2 als Eingangssignale, Insbesondere ist der Drehralensensor zur Rekon- 55 
struklion des Gierwinkels wichtig. Allernativ kann der Gierwinkel auch durch einen entsprechenden Gicrwinkclsensor 
gemessen werden. 

Die ini Block 3 vorgegebene Soll-Trajektorie und die im Block 4 ermiltelte Ist-Trajektorie werden in einem Verglei- 
cher 8 verglichen. Aus dem Vergleichsergebnis und aus Signalen der Blocke 1 und 2 berechnel der Funktionsblock 5 die 
SlellgroBe. Der Vergieich zwischen den Soli- und Tsl-Trajektorien ermoglichl eine genaue Regelung des Lenkwinkels 60 
mitlels der im Block 5 bcrechneten StcllgroBe. Diese Regelung ist moglich, da die Lenkeingriffe von einer Regel-/Steu- 
ereinheit ausgefuhrt werden. Die im Funktionsblock 5 berechnete SteUgroBe wird im Funktionsblock 6 gefilterl. Diese 
Filterung bewirkl eine Glattung der Flanke der SlellgroBe und erreichtdamit, dass die Lenkbeschleunigung und der Ruck 
am Lenkrad nicht zu hoch werden, AuBerdem werden dcm Funktionsblock 6 auch Fahrzeugdaten aus dem Block 1 zu- 
gefiihrt und dort gefiltert oder in die Filterung der StellgrSBc mit einbezogen. ^ 65 

In dem Vergleicher 8 konnen neben der 1st- und der Soll-Trajektorie auch Fahrzustandssignale, bspw. die Orientierung 
des Kraftfahrzeugs, miteinander oder mil den Fahrzeugdaten verglichen werden. Der Funktionsblock 7 reprasentiert ein 
Siellglied, das als cin Lenkstell motor ausgebildct ist. Die Sensoren und der Lenkslellmotor konnen lei! eines fahrdyna- 
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mischen Lenksystems des Kraftfahrzeugs sein. Die zusatzlichen Koslen fur einecrfindungsgemafic \forrichlung in einem 
Krafifahrzeug konnen so auf ein Minimum redzuicrt werdcn. 

Dieoben bezogcn auf Fig. 1 beschricbenen Funktioncn des Einparkassistenten konnen von einerRcgel-/Steuereinheil, 
z. B. einem ohnehin im Kahrzcug vorhandenen Fahrzcugrechner ausgefuhrt werden. 

Nachslehcnd werdcn unlcr Bezug auf die Fig. 2 und 3 die geomclrischen Grundlagen zur Ermiillung einer Trajekloric 
auf der Basis eines Klothoidbogens beschrieben. 

In Fig. 2 ist graphisch der Zusammenhang zwischen dem Krummungsradius R, dem Winkel 6 und dcm Weg s einer 
belicbigen Bahnkurve veranschaulicht Fig. 2 zeigl, wie der Winkel 9 sich mil der Anderung des Wegs s in Abhangigkeit 
vom Krummungsradius R vernal!. Die Krummung c(s) ist mil Gleichung 1.1 gegeben: 
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C (s) = 



Gl . 1.1 



ds 



Der Winkel 0 berechnet sich aus dem Weg s anhand der folgenden Gleichung: 

Gl. 1.2 
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Diese Gleichung laBt sich mil Hilfe der Gleichung 1.1 wie folgt ausdriicken: 



Gl . 1.3 



Aus dem Winkel 0(s) werden die kleinen Anderungen (dx, dy) der kartesischen Koordinaten (x, y) berechnet: 

dx(s)l TcosO) • ds 
dy(s)J |_sin(9) • ds 

Die Koordinaten (x, y) werden aus der Gleichung 1 .4 abgeleitet: 



Gl. 1.4 



x 0 + Jcosl 



f A 



0 

t 



y 0 +Jsin 0 O + Jc(w)-<*w ydt 



Gl. 1.5 



45 Die allgemeine Gleichung 1 .5 wird fur den speziellen Fall der Klothoide vereinfacht. Die Klothoide ist eine Kurve, de- 
ren Krurnmung c(s) sich linear mit dem Weg s verandert. Diese Kurve wird auch als Comu-Spirale (siehe Fig. 3) be- 
zeichnet. 
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c(s) =k • s + co GL 1.6 

Aus dem Einsatz der Kriimmung (siehe Gl. 1.6) in die Formel 1.5 ergibt sich: 



tt)] = 



x 0 +jcos d 0 + 'f(k-w+c 9 ) dw\>dt 



0 
$ 



0 

I 



y 0 + J sin 0 e + j (k • w + c 0 )• dw 



dt 



was sich unter den Bedingungen: 
So = 0, x 0 = 0 c 0 = 0, v 0 = 0 GL L8 



Gl. 1.7 



65 wie folgt vereinfachen lasst: 
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Gl . 1.9 



Die Integration der Funktioncn sin(u 2 ) und cos(u 2 ) ist nichl trivial. Dai'ur wird die Rcihenenl wicklung der Lrigononie- 
rischen Funklionen angewandi. 



x{s) 

M 



J 

f 



f [->■'•) 



t V 



E(-iy 



ri. > 

2 



(2/X + l) 



*dt 



Gl. 1.10 



UnLer besliminlen Bedingungen von Kon vergenzen der Reihen (Gl 1 . 1 0) kann die Reihenfolge der vSumnie und der In- 
tegration inverticrt werden. Dicsc Bedingungen sind in dem vorlicgcndcn Ausfuhrungsbcispicl (GL 1.10) crfulil. 
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| ( . ir .U_L. rff 
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(2n + 1) 
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Gl. 1.11 



Die Gleichung (1.11) lasst sich wie folgl transformieren: 



y(s)] 



*2-(4n + 3).(2ii + a 



Gl. 1.12 
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Gl. 1.13 



Die Gleichung 1.13 dienl dazu, bedeutende Punkte der Trajektorie schnell zu berechnen. Im folgenden Abschnitt wird 
das Verfahren angewandt, urn eine Einpark-Trajektorie zu berechnen. 

Weiterhin wird bezogen auf die Fig. 4 bis 7 die Einpark-Trajektorie mil Hilfe eines Algorithmus berechnet, der auf der 
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vorangchcnd crlauLerten Glcichung 1.13 heruhl. 

In Lui liver Lcnkvorgang 

5 Es sei angenommcn, dass das zu parkcnde Fahrzeug parallel zu der Parkliicke slchl. Die Trajektoric in der Langsrich- 
tung wird passend zu der existierenden Parklticke vorausgcselzl. Inluiliv soil die Einpark-Trajeklorie die folgenden Pha- 
sen beinh alien: 
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1. Geradcaus riickwarts fahren, 

2. wciterfahrcn (eventucll langsamcr) und das Ixnkrad nach rechls bis zu dem Lenkeinschlag drehen, 

3. wciler riickwarts fahren, 

4. Lenkrad nach links bis zuni Lenkeinschlag drehen, 

5. wciler riickwarts fahren, 

6. Lenkrad wieder gerade slellen, und 

7. das Fahrzeug anhaltcn. 

Berechnung des Lenkwinkels 

Die oben beschriebenen inlui liven Phasen sollcn formaiisicrt werden. 

- Wegen der einfachen Handhahung von Klothoidcn wird angenommen, dass die Phasen 2, 4 und 7 Klothoid-Tra- 
jeklorien sind. 

- Wegen der Symmetric des Einparkvorgangs sind die Phasen 2 und 6, 3 und 5 syrnmetrisch. 

Die Bestimmung der Phase 2 wird anhand der Fig, 4 hergeleitet. Die Klothoide sind durch einen Parameter k be- 
slimmt, der auf der Begrenzung des Lenkwinkels und der Fahr- und Lenkgeschwindigkeiten beruht. 

Die Lange der Phase 3 isl so berechnet, dass das Fahrzeug lief genug in die Parklticke fahrl. Der Einfluss dieser Lange 
auf die Trajektoric wird anhand der Fig. 6 und 7 dargcstclll. Insbcsondcrc zcigt die Fig, 6 die Trajektoric des Fahrzcugs, 
wenn die Phase 4 nicht existiert. 

Die wichtigen Punkte fur die Berechnung der Trajektorie sind in den Fig. 5 und 6 rait den Buchstaben A, B, C, D, E, F, 
G, R gekennzeichnet. 

In Fig, 4 ist schematisch bei einem Fahrzeug mit eingeschlagenen Vorderradern der sich ergebende Radius R = l/c(s) 
und der Lenkwinkel 8(s) dargestelll. Die Klothoide ergibl sich zu 

c(s) =k • s + cq Gl. 2.1 

Der Ackermannwinkel isl 

8(s) = arctan[L • c(s)] GL 2.2 



c = tan 



Daraus ergibl sich: 




Gl . 2.3 



max 



.max 



ss tan 



Gl . 2.4 



50 Dies ergibt 



55 



60 



65 



S 



max 



tan 



max 



Der Lenkwinkel ergibt sich zu: 

L-c L-k-v 



Gl. 2.5 



5 = 



1+ [L*c] 



1+ [L-c] 



k-L-v max s 6 M ' 



max 



Daraus erhalt man den fur die Klothoide bestimmenden Parameter: 
8 max 



k = 



Gl . 2.7 



.max 



Gl . 2 . 6 



Dabei findet eine Begrenzung der Lenkwinkelgeschwindigkeit 8 < Om"" 1 *, des Lenkwinkels 8 < 8 v max und der Fahr- 
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gcschwindigkcil v < v maA stall. Das Ergebnis des Einparkvorgangs mil dem zuvor crlauierlcn AlgoriLhntus isl in Fig. 7 
dargesiclll, wclche in einem x-y-Koordinalensyslem einc bcispiclhaflc Einpark-Trajcklorie und den zugrundelicgcnden 
Soll-Lcnkwinkel vcranschaulicht. to 

Um die Slcuerung im Fahrzcug zu programmiercn, wird dcr gefahrcne Weg bcnoligl. Im Fahrzeug wird diescr Weg 
mil aktiven Radgcschwindigkeilsscnsorcn oder in vercinfachler Form mil JTilfc cines Weggebcrs gemesscn. Die Radge- 5 
schwindigkeitssensoren konncn die Radgcschwindigkcil bis zur Gcschwindigkcil Null prazise crfasscn. 

Bci dem oben bcschriebcncn System darf dcr Fahrer wahrend des Einparkvorgangs Lcnkcingriftc durchfuhrcn. Dicsc 
LcnkcingrilTc haben aber kcincn EinfluB auf das Manovcr. Falls beim Einparkcn ein Hindernis im Wegc stent, soil dcr 
Fahrer bremsen und den Bin park vorgang sloppen. Da dcr J^enkradwinkcl mil dem zugrundelicgcnden Ixnksyslcni sen- 
sorisch crfassl wird, werden die FahrereingrifTc am Lcnkrad durch den Lenkstellrnolor wahrend des Einparkcns kompen- 10 
sicrt. Dicsc Vorgehensweisc ermoglichl, dass dcr Fahrer trolzdcm das Gcfuhl hal, den Ein park vorgang sclbsl zu slcucrn 
und sich deshalb wohl fuhlt. 

Aufgrund der vom Drchralenscnsor gclieferlen Signale wird dcr (iicrwinkcl hcrcchnel. Hci hochdynamischen Fahr- 
manovern kann dicse Berechnung u. U. zcillich problemalisch scin. Beim Einparkcn tret.cn dagegen in der Rcgcl keine 
Schwierigkeilen auf, da sich die Fahrgeschwindigkcit und die Dynamik des Fahrmanovcrs in Grcnzcn hail. 15 

Somil ermoglicht dcr Einparkassisleni uber die Berechnung des Gierwinkels einc echtc Rcgcl ung des Lenkwinkels 
durchzufuhren, damildie Fahr/cugoricnlicrung dem erwartcten Verhallen enlspricht. Mil dieser Regeiung konncn Feh- 
ler, die zu ciner Abweichung zwischen den gefahrenen und dcr bcrcchnclen Trajekloric fuhren konnen, wie bspw. Fehler 
in der Lcnkanlage oder unterschicdliche Rcibungcn, korrigierl werden. 

Da der Sprung des dem Lenkstellmolor als StellgroBe zugefuhrlen Signals zwischen den Phascn, in dencn der Lenk- 20 
winkel konstant isl (Phascn 1, 3 und 5) und den Phasen, in denen sich dcr Lenkwinkel veranderl, zunachst abrupt ist, wird 
die SlcllgroBe in dem in Fig. 1 gezeigten Funktionsblock 6 gefiltcrt, indem die abruptcn Sprungc dcr StellgroBe geglaltet 
werden. Dabei kann die SlcllgroBe gcfillcrt werden, damit die Lenkbcschleunigung begrcnzl ist. Da die Soll-Trajeklorie 
unverandert bleibt, konnen Abweichungen von der Soll-Trajektoric auflreten. Es werden also lemporare Abweichungen 
von der Soll-Trajeklorie geduidet, um ein gleichformiges Fahrmanover zu ermoglichen und um dadurch den Fahrkom- 25 
fort zu erhohen. Die Abweichungen zwischen der Soll-Trajeklorie und der Ist-Trajeklorie werden im Laufe des Einpark- 
vorgangs durch die Rcgcl-/ Slcuercinhcit mil Hilfc des crfindungsgcmaBcn Vcrfahrcns korrigierl. 



Patent anspruche 



30 



35 



1. Verfahrcn zur Unterstutzung des Einparkens eincs Kraftfahrzeugs, das mil einem Lenkstellrnolor und Sensoren 
zum Erfassen der Fahrzeugposilion, des Fahrzuslands und veranderlicher Umgebungsbedingungen ausgerustet ist, 
wobei auf den Bcfehl eines Fahrers hin eine geregelle UnlerstUtzung des Einparkvorgangs milteis des Lcnkstellers 
und geslutzt auf vorbeslimmle Falirzeugdaten und auf Signale der Sensoren ausgeluhrt wird, gekennzeichnet 
durch folgende Schritte: 

A Erfassung einer das unlerstutzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines 
Initialisierungssignals; 

B Erfassung der momentanen Fahrzeugposilion und des Fahrzuslands aus den Fahrzeugdalen und wenigslens 
aus einem Gierwinkelsignal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugten Signa- 40 
len; 

D Vorgabe einer oder mehrerer Soll-Tajektorien, die eine von der Fahrzeugposilion, dem Fahrzustand, den 
Umgebungsbedingungen und den Fahrzeugdalen abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs 
angeben; 

E Erfassung einer jeweiligen Ist-Trajeklorie, abhangig von den jeweiligen in den Schrilten B und C erfassten 45 
Signalen; 

F Vergleich der in Schritt D vorgegebenen Soll-Trajektoric und der in Schritt E erfassten Ist-Trajektorie; und 
G Berechnung der jeweiligen StellgroBe fur den Lenkslellmotor aus dem in Schritt F erhaltenen Vergleichs- 
ergebnis. 

2. Verfahren nach Anspruch I, dadurch gekennzeichnel, dass der Len ks tell motor und zumindesl ein Teil der Sen- 50 
soren Teil eines fahrdynamischen Len ksy stems des Kraftfahrzeugs sind. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass das in Schritt B erfasste Wegesignal von je ei- 
nem an jedem Fahrzeugrad befindlichen Radgeschwindigkeitssensor erfasst wird. 

4. Verfahren nach einem der Anspruche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkel- 
signal von einem geeigneten Sensor gemessen wird. 55 

5. Verfahren nach einem der Anspruche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkel- 
signal aus einem oder mehreren in den Schritten B und C anderweilig gemessenen Signalen, insbesondere aus ei- 
nem Drehratcnsignal oder aus dem Wegesignal, rekonstruiert wird. 

6. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die Umgebungsbedingun- 
gen in Schritt C mittels eines UHraschallscnsors erfasst werden. ^ 

7. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet dass die in Schritt C erfassten 
Umgebungsbedingungen die Form und/oder AusmaBe einer Parklucke angeben. 

8. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die oder jede in Schritt D 
vorgegebene Soll-Trajeklorie aus einem oder mehreren KJothoidbogen und/oder einem oder mehreren Kreisboeen 
zusammengesetzt werden. 65 

9. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die im Schritt E berechnete 
StellgroBe einer Filterung unterworfen wird, um zu vermeiden, dass die Lenkbeschleunigung und der Lenkruck zu 
hoch werden. 
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10. Verfahren nach cinem der vorangehenden Anspriichc, dadurch gekennzeichnet, dass Lenkeingriffe dcs Fahrcrs 
loleriefl werden, abcr keinen Einfluss auf den Einparkvorgang nehmcn. 

11 . Verfahren nach cinem der vorangehenden Anspriichc, dadurch gekennzeichnet, dass die Einparkgeschwindig- 
keit durch Gas- und Bremspedaleingriffe des Fahrcrs beinflusst und die Lcnkwinkel ausschlieBlich durch die Stell- 

5 bewegungen des Lenksl ell motors bcwirkl werden. 

12. Vorrichlung zur Durchfuhrung des Vcrfahrcns nach cinem der vorangehenden Anspriichc, dadurch gekenn- 
zeichnet, dass die Vorrichlung eine Regel-ZStcuereinheit, die von den Sensoren in Abhangigkeit von der Fahrzeug- 
posilion, deni Fahrzusland und den verandcrlichcn Uingcbungsbedingungen erzeugten Signalc sowie die Fahrzcug- 
daten empfangl, Miltcl zur Bercchnung einer 1st- lVajektoric aus den Sensorsignalen und den Fahrzcugda1.cn, Miltcl 

10 zurn Vergleich der jeweils berechnetcn Tsi-lVajcklorie mil einer vorbeslimmten Soll-Trajekiorie und Miltel zur Be- 

rechnung ciner StellgroBe fiir einen Ijenkslcllmotor aus dem Vcrgleichsergebnis aufweist. 

13. Vorrichlung nach Anspruch 12, dadurch gekennzeichnet, dass die RegeWSteuereinhcit die von den jeweiligen 
Sensoren erzeugten Signale sowie dieFahrzeugdatcn von einer anderen Sleuer-/Regeleinheil in deni Fahrzeug emp- 
fangl. 

15 14. Vorrichlung nach Anspruch 13, dadurch gekennzeichnet, dass die andere Steuer-/Regeleinheit als ein fahrdyna- 

misches Lenksystern dcs Fahrzeugs ausgebildet ist. 

15. Vorrichlung nach einem der Anspruch 12 bis 14, dadurch gekennzeichnet, dass Filtermitlel in funktioneller Ver- 
bindung mit der Regel-/Steuereinheil vorgesehen sind, urn die von der Regel-/Sleuereinheit bercchnete StellgrftBe 
so zu filtern, dass die Lenkbeschleunigung und der Lenkruck nicht zu hoch werden. 

20 ; 
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